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Ie INTRODUCTION 


The ground directed bombing system Simulated is 
conceptually similar to the USMC AN/TPB-1D produced by 
Sierra Research Corporation. This system tracks the 
meet cal aircraft with a conical scan radar, filters the 
noisy radar data, calculates heading commands based on the 
smoothed trajectory, and transmits this guidance information 
to the pilot via the Tacan navigation system located in the 
eoGkpit. This Reaging @itosmase2on directs the pilot to fly 
M@menaitctate SO that 1tS ground track vector passes through 
the calculated ordnance release point. Audio signals 
transmitted to tne pilct designate the bomb release time. 

In an operational environment such a system would 
Boscsibly be required to track and guide aizcraf* conducting 
Significant maneuvers enrout>= +o the target. These 
Maneuvers would most likely be dictated by tactical doctrine 
or by «he threat environment. 

With this cperational model in mind an appropriate 
concern is the capability of a grecund directed bombin 
Meee M CO track and guide an aircraft axhibiting randon 
Maneuvers until moments rior tc bomb release. PS 


eCbvious that the smoothing filter should be able to respond 





to maneuvers, yet settle quickly to an accurate solution as 
mae pilot steadies the aircraft. mmese Conrliic cing 
requirements are investigated utilizing both alpha-beta and 
Kalman filtering techniques. 

Similar filtering techniques were utilized for a 
Ermulation of the USMC AN/TPQ-27, [1]. However in that 
ground directed bombing systen, control signals were 
directly coupled to the aircraft aerodynamic controls, «hus 


Slemoanating the uncertainty of pilot response in the control 


HOOD. In that study significant improvements in fiiter 
response and accuracy were realized by INeciudang 
deterministic forcing autopilst commands in the state 


Pst ifMiat ion via the Kalman filters. 


10 





II. GROUND DIRECTEL BOMBING SYSTEM (GDBS) SIMULATION 


a. COORDINATE SYSTEMS 
A cCarteSian coordinate system was chosen for the 


aircraft dynamics model and a radar centered inertial 


reference frame. In this reference system the y-axis is 
@irected toward true North and the x-axis toward the east. 
The z-axis is directed away from the center of the earth. 


All radar measurements of aircraft position, however, are 
obtained in spherical polar coordinates, i.e. slant range 
(R), azimith angie from true North (A), and elevation angle 
fy from the horizontal. Figure 2.1 shows «hese coordinate 
systems and their tzansformation relationship. Wind is 
Mereeled With a constant velocity in the x-y plane with no 
vertical component. 

Gtavariaee Of the Garth and the fact that pilot heading 
MpeOrMaction 1s oriented to magnetic north, were not taken 
Bieo account in the simulation. Aveo Mem) £ Dalle stics and 
Mrer]efOrS coriolis forces weré uct included in the model. 
Mie alucraft iS simply directed to a release point in space, 
@o2ch in a full simulation would be derived from the 
mmencceed bomb trajectory ,ballistic winds, coriolis forces, 


mmeea Number Of other factors, all of which are iapertan® to 


17 








Fig. 2.1. Model Simulation 
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= R cos(E) sin(A) 


R cos(E) cos (A) 


Pasi (s ) 


Coordinate Systems 





the problem as awhole but aré not necessarily germane to 
the objective of evaluating the response and accuracy of 
alternative state estimating filters for a goal oriented 
Maneuvering bomber. Thus the simulation has been simpli fied 


appropriately. 


Be. AIRCRAFT DYNAMICS MODEL 

The dynamic model of the aircraft for the purpose of 
simulation was assumed to be a free inertial (1/s*) plant 
since the bombing profile dictates a constant aircraft 


airspeed. iiewas=secre=e realizat:on of this plant is shown 


me (2.1). 
X(k+1) = OCK+I/k) X(k) + A(K+1/k) U (k) (221) 
where 
ae OTUs 6 
Goa Ue “OF 0. <0 
uO 1 T 0-0 
O(k+1/k) = O00) 0.80 (222) 
O00 01T 
(meno 0 0 4 


ae 





772 0 0 
T 0 0 
2 
0 172 0 
A(k+iy/k) = 0 +r OQ (2. 3) 
0 o 72 
0 Oo ff 


In the controlled mode the i peraee model simulates the 
pilot responding to heading inputs er from the 
radar site to the TACAN navigation system in the cockpit. 
Greemodel is driven by a pilot/aircraft control function 
Similar to that developed in [1] and shown in Figure 2.2. 
The input is bearing to the target and the output is a bank 
angle which generates a heading rate that can be transformed 
Maro X—-y acceleration components for e@ntry into the dynamic 
model. It is assumed that in the controlled node heading 


changes are made with coordinated turns performed by the 


Pilot in response *o heading commands displayed by «he 
TACAN. The Pelot-7acEecrart COntTOlLler induced X7y 


accelerations are depicted in Fiqure 2.3 and summarized by 


med) and (2.5) kelow. 


%(k) = V(k) cos(W(k)) Wk) (2.4) 


¥ (Kk) =-¥ (kp) sin( wk) ) (kK) (2.5) 
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Controller 


Chas), aye Ro11/9s) ac 


-36° Response Dynamics 





Compute picace  SSt. Measurement 


Heading Err. Filter Process 





Bearing to Tgt. 


wo 


Fuge 2.2. Pilot/@ircraft Controller Configuretion 


w(x) and V(k) are airerafit neading and velocity respectively 
at time k, and W(k) is the heading rate which is derived in 
(2.6) chrough (252) from the ftree-body diagram shown in 


Megure 2.4. The aircraft weignt is shown in (2.5) below. 


W = mg = L cos@ (20) 
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Pig. 2.3. Pilot Induced X-Y Accelerations 


E@Wation (2.7) depicts the centripetal force generated ina 
mpen, where R is the turn radius, L is lift, V is velocity, 


and @is the bank angle. 


Bev /ne=W ,the turn rate, so 


pP=nvW=L siné@ (2.8) 


16 





Pig. 2.4. Coordinated Turn Free-Body Diagram 


fMeyecaging (2.8) by (2.6) and rearranging terms yields (2.9), 
which defines W, the aircraft turn rate, as a function of 


aircraft bark angle 8, and velocity V. 
Y= q/V tan@ (2.9) 


From [1] the aircraft roll response is assumed to be of 
the form shown in (2.10) where T is the roll response time 


Senstant. 


tee 





-- = 17tsr + 1) (2.10) 


No effort has been made to specifically model pilot delays 
or response to visual inputs from the TACAN. 
In the maneuvering mode the maneuver model described in 


f2] was used and is shown in Figures 2.5 and 2.6 . 





Fig. 2.5. Acceleration Probability Density Model 


This was simulated for uncontrolled random flight since the 
aircraft is assumed to typically move at a constant velocity 
mech turns, é€vaSive maneuvers, and waar +urbulence 
interpreted as perturbations upon the constant velocity 


ee JCC OLY. These maneuver perturbations or accelerations 


18 





R(a) 


LL — a 


ey A a 


eat SE ame: 


Pig. 2.6. Model Acceleration Correlation Function 


can be specified by a magnitude, with probability P(a) from 
Meevi), and aduration cf R(a) from (2.12), the correlation 


mime ich Of akrcraft acceleration. 


P(a) = lees Ne Pg) 2A (25001) 
R(a) = 4 exp (-tf{al]) . (22-47) 
ime ecceleration Ain (2.11) TS S2he Maxemum tha= Can 


tTeasonably be expected from the pilot/aircraf= in the 


environment described. Py is that probability assigned to 


the maximum acceleration +A, P, is that probability assigned 


0 


pv 
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+o no maneuver, and the assumed probabilitity distribution 
between these values is unitorm with amplitude P (a). 
Equation (2.12) is the correlation function which yields an 
acceleration time duration, R(a), which is based on the 
Magnitude of the acceleration |fa|{. Mand t are simply 
correlation factors which determine how the (a) varies over 
the range of possible acceleration amplitudes. From this 
model one can see how the duration of a high G maneuver for 
threat avoidance would be considerably less than for a low G 


clearing turn. 


See GDBS MODEL IMPLEMENTATION 

The GDBS model was simulated on an IBM 370 in single 
PiseeC2iSi0On Fortran. Figure 2.7 shows the basic flow diagram 
for the computer program, “meen Iclemenes this simula =icn 
model. The module labeled "Scales EStinazvwon Filter 
Bep=esents those filter algorithms discussed inthe next 


chapter. 
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III. AIRCRAFT STATE ESTIMATION 





A. BACKGROUND 

A great deal has been written on the theory and 
application of estimation filters. ie past. cular, fe] 
provides a good overview of several such filters, including 
the alpha-beta and Kalman filters, and compares their 
relative performance not only in terms of accuracy and in 
response, but also in terms of computer implementation costs 
in conputation time and storage overhead. 

The general conclusion is that the Kalman filter 
out-performs an alpha-beta filter of comparable order by 
mpout 2 to 1. HOWeIneS eat ne. SOSt fer such perfcrmanc2a 2s 
increased computer computation time and memory, of the same 


relative nagnitude. 


Be GENERAL DESCRIPTION OF THE ALPHA-SETA FILTER 

The basic *«heory of the alpha-beta filter is derived 
Becm Minimizing the mean square error of the filtered 
states. A classic analysis of the alpha-beta filter is 
previded by {3]. The filter recursive equations are 


Summarized below. 


x (K/k-1) =x (k-1/7k-1) + T x (k-1/k-1) (321) 
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x (k/k) mK K— 1) + “erm(2(k) <- x (k/k-1) { 3. 2) 


x(kK/k) = x (kK/e-1) + B/T (z(k) - x (K/K-1)) (3.3) 


x(k/k-1) ais the predicted position, xX({k/k) is the updated 
position, x(k/k) is the updated velocity, and z(k) is the 
noise contaminated measurement of position at the k-th 
ont er Vek . T is the sample rate of the measurement process, 
aqand Bare usually fixed real constants. ‘AS porn@ed out in 
{ 4] these alpha-b¢ta equations are analogous to a steady 
state Kalman filter. For ‘typical parameter values <+he 
alpha~beta filter is simply low pass with a heavily damped 
time response. Thus the filter eliminates not only most 
high frequency measurement and precess noise, but also most 


Maneuver energy from the state estimate. 


() 


GS. GENERAL DESCRIPTION OF THE KALMAN FILTER 

The Kalman filter generates a minimum variance ¢stimate 
cr the plant(aircraft) state vector when the neasuremer+ and 
plant process noise statistics are known and confcrm to the 


criteria shown below. 


E(V(kK)V(9)7) = R(k) 8(kK,3) (3.4) 


Ze 





E(A(W (k) W(3))A7) = Q(k) 8(K, 5) (3.5) 


E(V(k)¥#(9)') = 0 for all k, j (3.6) 
: QO k#¥ 
where Slike) | = (3.7) 
1 k=3 
A linear time-invariant system is assumed, as in the 
discrete model representation shown in Figure 3.1. K (k) 


represents the (n x 1) state vector, Z(k) the (m x 1) output 
vector, @(k) the state transition matrix, H(k) ‘the (m x n) 
observation matrix, W(k) state excitation or process noise, 
and V(k) the measurement noise. 

The Kalman filter recursion algorithm is summarized 


below. 


K(k# 1) = P(kK)X(k) + Ak) W(k) (3.5) 


Z(K) = H (kK) X (kK) + V(k) (322 } 


AN AN 
X(kK/K-1) = O(kK,k-1) X (k-1/k-1) + Ak) U (k-1) (3.10) 
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Dynamic Model Measurement Model 
v(k) 


W(k) X(k) | | 
ai D H(k) pee ZU) | 
J , 


Kalman Filter 


Z(k) 609 
G(k) 
o e(k) o 


—_—, =a ==> ap - = —_ — —= 


Fig. 3.1. Dynamic System Model and Discrete Kalman Filter 
P(k/kK-1) = O(k,k-1) P(k-1/kK-1) b(k,k-1)) + O(k) (3-11) 


G(k) = P (k/k-1) H(k) | H(k) 2 (kK/k-1) H(k) | + R(x] (S42) 


Pes 





£ (k/k} = f(K/K-1)+G (k) [z (x) = H (Kk) (k/k~1)] (3.13) 


P(k/k) = (I - G(k) H(k)) BP (k/k-1) (3-315) 


R (k/k-1) denotes the estimate of the state vector X(k) based 


on (k-1) measurements, Z(1),2(2),-.-..2(k-1). 


D. FILTER ORDER CONSTI DERATIONS 

The filter order is chosen to match as closely as 
possible the expected plant dynamics of the system being 
modeled. A first order filter would be expected to estimate 
a constant velocity trajectory effectively anda second 
erder filter would accordingly observe a Ema eC= Cry 
exhibiting constant acceleration. The order is used here in 
the mathematical sense and refers to the ecrder of the 
differential equation that defines the filter. 

eeemee Tene saitcraft 25 known 60 be constrained to af 


constant velocity profile as it approaches «he reléas 


D 


point, it would seem reasonable to select a first orde 


ry 


filter for nodeling. The aircraft dynamics are anticipated 
to depart from the first order model enroute to the «argeat 
thus creating transient errors which must be dealt with by 


Belcer adaptation. iiemiGetoCtnateveetO this strategy is «o 
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increase the order of the filter to observe these high 


energy maneuvers for state 2stimation. However, tne 
settling time of a first order filter is generally iess chan 
that of a second order filter as discussedin{5] and 
graphically illustrated by tne first and second crder Kalman 


gain schedules shown in Figures 3.2 and 3.3 respectively. 


POSITION GAIN 


Ok = Pee oe 20. eo) 


Mes EC) 


Fig. 3.2. First Order Kalman Gain Schedule 
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Fig. 3.3. Second Order Kalman Filter Gain Schedule 


fe FLLTER ADAPTATION 
1. Background 
No matter what the order or the complexity of the 
filter type selected, it cannot be expected to fully mecdel 
fame eircrtaft dynamics and process noise covariance. The 


model is based on a2 linear time-invariant sys*em and the 
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process noise is assumed to be stationary, white, and 
Gaussian. During portions of the flight, paricularly as the 
aircraft approaches the release point, the system dynamics 
are expected to approximate very closely the assumed model. 
However,. during other portions of the flight the aircraft 
dynamics are anticipated to depart significantly from the 
filter model. Certainly the pilot should not be constrained 
to behave ina manner consistent with the model, if the 
environment dictates otherwise. 

Saie2 )cne OLllot/alrcraft dynamzcs are not fully 
modeled, she suboptimal filter that results might be 


expected to diverge, e.g. the error covariance generated by 


the male er and tie” “actwal error covariance become 
snconsistent. The deeitze iS EOr the filter to *ransition 
smcothiy between accurate estimations, when the aircraft 


dynamics conform to those assumed for «he model, and less 
accurate estimations, when the aircraft dynamics do not 
agree with the model. AWeadapeaiVe “filter realizes this 
smooth transition by adjusting filter parameters to vary the 
filter bandwidth +o allow a more consistant match between 


mie calculLated and actual filter error covariances. 


Zo 





In the case of Kalman filter adaptation, the 
calculated error covariance becomes a function of the 
measured data indirectly by making the filter parameters 
dependent on the observed aircraft motion. The adaptive 
techniques for the alpha-beta filter are similar in concept. 
In e€ither case the adaptive process is conceptually straight 
forward; first divergence is detected, then the filter 
parameters are modified. 

In the case of a ground directed bombing system of 
the type considered here, tha aircraft's behavior could 
depart from the filter model in a random fashion when the 
pilot maneuvers in response to a random event in the 
environment, or deterministically when he responds to target 
bearing inputs from the ground radar. These «wo situations 


may be treated separately or together for the purpose: of 


filter adaptation. To treat them separately, as random and 
deterministic PLOCESSES, requires knowledge of the 
mo. /aircraft response to target bearing inputs. haa ene 


case of the ground directed bombing system described in [1] 
this transfer function was known quit¢ accurately since the 
amp: Signals from the ground radar were directly coupled +o 


Pie AITCCrart aercdynamic controls, with «the uncertainties of 
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pilot response isolated from the control loop. With that 
information the deterministic forcing could simply be 
integrated into the filter model. Unfortunately such is not 
the case for this simulation. A unigue approach to this 
problem will be discussed later. The alternative apovroach 
is to consider both processes to be random and preceed from 
that assumption. 
2. Innovations Statistics and Maneuver Detection 

As descibed in ({5] the innovations or residual 

sequence of a filter can be obssrved in order to detecta 


klas that would indicate divergence of the state estimate 


BEem the true state. This is given by 


y(kK/k- 1) = 2(k) - Hk) ¥(kK/k=-1) (3.15) 


By substituting for Z(k) from (3.9), the measurement nodel, 


we see that 


v(kK/k-1) = v(k) - H(kK) €(k/k-1) (3.16) 


A 
E(k /k-1) = X(K/k-1) - X(k) (32,17) 
Taking expected values , we find «hat 


E(v(k/k-1)) = 0 es) 
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B(p(k/k-1) pi(k/k-1)) = R(k) + H(k)P (K/k-1) #7 (k) (3. 19) 


Thus by referring to the model statistics for R(k) and 
P(k/k-1), it becomes clear that when the system conforms *o 
the system model, i.e. the filter is operating optimally, 
the innovation sequence should be zero-méan Gaussian with 


Variance 


oz = ok) + P(k/k-1) (3.20) 


Vv 


k One appraoch to adaptation considers the correlation 


of the innovation sequence, where the autocovariance 


: : ae i 
eee eV (K7 Ka Vip (k=2/K=1=2) ) (3.21) 
Brould vanish for 1#0. Based on these statistics, maneuver 
detection can be realized by observing the signs of the 
innevation sequence. The probability that a given sequence 
Memeither positive or negative is 
7 : 
E052 yout = => (3222) 
1-N 
PRoecther approach utilizes (3.23) 
| b (K)] > Ca_ (k) (3.23) 
YN 


to declare a maneuver when Vy exceeds a specified value, 


usually two or three standard deviations of g.. 


3% 





Subsequent to maneuver detection, the filter 
parameters must be modified to correct filter divergence. 
Reference [5] summarizes numerous ‘techniques, some bé¢eing 
quite complex and computation intensive. The strategy 
chosen for this simulation was simply to reset the error 
covariance in response toa detected maneuver. In the 
Situation of a ground directed bombing system, the resulting 
cost of a false detection becomes high only as the aircraft 
approaches the release point. This cost can be reduced by 
disabling filter adaption within a specified time to go. 

Still ancther approach attempts to adapt the filter 
Bandwidth by adjusting Q(k) in (3.11). This approach, 


investigated in [1] and [6] calculates Q(k) by 
Q(kK) = a Del(k) Del(k) + b Del (k~-1) Del (k-1) (3. 24) 
where a and b are determined by data analysis, and 
Z A A 
Dei (k) = X(kK/k) ~- X(k/k- 1) (3.20) 


A variation of this technique that looks at only the change 
in the highest crder state is investigated in the Kalinan 
fe ter simulation. 

Most of the discussion thus far concerning filter 


adaptation has been directed toward Kalman filters. bo kers 
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approaches +o adapting alpha-beta filter simply open the 
bandwith by switching toa different set of parameters when 
a maneuver has been detected. Reference [4] discusses an 
adaptation scheme that is more nearly optimal in the sense 
of covariance matching. However, for the sake of comparison 
the simple parameter switching technique 1s implemented in 
the alpha-beta filter simulation subroutine, since that is 


the approach used in the AN/TPB-1D. 


F. ESTIMATION OF PILOT RESPONSE TO TARGET BEARING INPUTS 
As discussed in the previous section, aircraft dynamics 
depart from the filter model randomly when the pilot 
responds to events in the environment and deterministically 
when he responds to target bearing inputs from the GDBS. Tf 
his response to these inputs were known with some degree of 
certainty, then deteministic forcing might be included in 
Bees tilter model in amanner similar to ‘that found in 
and [1]. The importance of identifying parameters which 
define a system so that modern control strategies can be 
implemented is discussed in (7]}. in this case the 
parameters would be those that describe «he pilot/aircraf+ 


response to heading inputs. 
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By using an Autoregressive Moving Average (ARMA) 
representation for the pilot/faircraft svstem, and Kalman 
filtering to precess the heading-in(actually heading error 
from the veiw point of the pilot), bankangle out data, the 
coefficients associated with the ARMA equaticn could be 
identified. From [7] we know that the pilot/aircraft system 


can be represented by the ARMA equation 


™ n 
g(k) = 2a. @(k-3) - Ub. 6(k-3) (3.26) 
j=0 J 5 j=1 2 
where the present bankangle output, Q(X), is a linear 
combination of past outputs, @(k-3), and of past and 
present heading error inputs, aay Estimating the 


coefficients of this ARMA equation can be formulated as an 
adaptive Kalman identifier, where the heading error and the 
bank angie are simple functions Ge “he velocity and 
acceleration stat2 estimates generated by the Kalman state 
estimation filter previously discussed. 

If the a, and dD, coefficients of she ARMA equation are 
eeasea aS States of the pilot/aircraft systen, then the 


State vector peccmes 


pp 





(seo) 


io 


ES 





Wwe assume that these coefficients experience 


perturbations so that 


a; (k+1) 
k+ 1) 


a. (k) + w(K) 


Ds ( 


Equation (3.26) then becomes 
m n 


a(k) = doa. @(k-3) - Dob. o(k-§) + v(k) 
j=o0 J § J 


where Ww. (Kk), w5(k), v(k) are noise processes that 
same statistics described for the Kalman filter 


Combining (3.28) and (3.29) we have 





a (k+1) a {(k) 
a———| = |= + ow (k) 
D (k+ 1) Bb (k) 
The measurment vector is defined, 
H(k) = | a,c) a(<-1) aa a(k-a) - 
- @(K-1) +--+. = @(k-n) 


From [7] the solution is then formulated as 





a _(k+1/k) (k/k=1) 

= ree I - kK)H(k ea a 

b (k+1/k) ome E ee | (K/k=1) BG (5) 79 (x) 
where 


=) 
G(k) = P(k/k=1) BC e) [Ht (X) B (K7K= 1) 87K) + R| 
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random 


(3.28) 


(Seo) 


have the 


earlier. 


(30) 


(o.. 3 |) 


(aeD) 


(33 3)) 





P (k/k) = P(k/kK-1) - G(K)H(k) P(kK/k-1) + Q (3 .34) 


w. (k) 
= —E : . (kK otk) B05 
Q w(K) Cw, (x) ne Ks) ( ) 

J 
R = E [v(k) v(k)] (3.36) 
and 
Bis 

a (k) @ (kK /k) a {k) a (kK /k) | 
P(k/k-1) = E —————= | = 1 = ——| -(——— resis 
il bce)! {o¢k7e || [foc] |S¢x7%9) 
Micra lizatson of the states(coef ficients) and “the ~“eeror 


Goveriance would be similar to that discussed in «he next 


Sect*On. 


eee CLITER TMPLEMENTAT IONS 

Three separats filter subroutines were déveloped to 
Simulate the filtering cf raw radar data generated by zhe 
ground radar of *+he bombing system previously descrined. 


Mme see filter configurations are oriented in c«zhe tare 


i) 


dimensional Cartesian coordinate system described in Chapter 
2 since the aircraft dynamics are assumed to be more nearly 
linear and well behaved than in the polar coordinate system 


in whicn the measurements are generated. This disparity 
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between the measurement reference frame and *#he mcedel 


dynamics reference frame results in a basic nonlinearity 
when transformations are required frem one frame to the 
other. Probably @ better coordinate frame for modeling 
aircraft motior would be one that translates with the 
aircraft and is oriented along the velocity vector. Swen a 
coordinate system was found to be very awkward and difficult 
to «6©cilmplement, especially considering the problem of the 
transformation nonlinearity just mentioned. 

The first of these filters, designated ALFBTA, is a 
simple sixth order alpha-beta filter with the parameter 
switching adaptation tecnique described in the previous 
section. Adaption is initiated when a heading tate cf 1 


deqree per second is observed for period of 5 seconds or 


more. The second and third subroutines implement 
sixth (KALMN1) and ninth (KALMN2) order Kalman filters 
respectively. Two S@2parate adaptive *echniques, which were 


described in the previous section, are included with each of 
these filters. The first of t+hese adaptive algorithns, 
designated ADPTV1, adjusts the Q(k) matrix frem changes 


computed in the highest order estimate. The secord 


(D 


algorithm, designated ADPTV2, simply resets the covariance 


Bie 





Ge. GEEOr Matrix P (k) when 2 bias is detected in the 
innovations sequence for more than one second. AS nentioned 
before, the difference between the sixth and ninth order 
filters is that the former do not estimate the acceleration 
Seates of the aircraft. Mie "cese Cf this additional 
information provided by the ninth crder filter is more 
computation time and computer memory. 

The aalircra it model is formed by defining a 


three-dimensional Cartesian state vector 


X,= exer. may (35.39) 


where x, y, and z are each one-dimensional two element state 
vectors (positicn and velocity) Or “ALPSTA and KALMN1, and 
three element state vectors (position, velocity, and 
acceleration) for KALMN2. The state prediction equations 


are given by (3.1) for the alpha-beta filter ard (3.10) ee 


eth Kaiman filters. For the Kalman filter configuration 


¢ O 
@ (k) = 0 ¢ 9Q (3% 39) 
0 0 ¢ 
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A O 
wAnS) = 0 4 
0 0 
where @#(k) and a4(k) are defined 
KALMN1 and (3.43) and (3.44) for 
= 1 FF 
d ( 0 4 
2 
72 
4A(k) = 
(K) ; 
| 
etx) = Q 1 
0 QO 
16 
a(k) = 12 
oly 


@ and A are in general functicns of k, 
this simulation they are not since a constant 
assumed and no extended predictions are required. 


eeu x WOuld be utilized to include deterministic 


the model, if this information 
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0 
0 
A 
by (3.41) 
Kavita 


were available 


however fo 


(3.40) 


acest. t2)aee fOr 


(3.41) 


(3 .42) 


(3.43) 


(3.44) 


4 


data rate is 


The U(k) 





However, Since an adaptive Kalman identifier was not 
implemented to estimate the pilot/aircraft response, no 
attempt was made to include deterministic forcing in the 
model. 
1. Kalman Filter Covariance of Measurement Noise, R (ky) 
Kalman filter theory assumes linear relationships 
among measurements and states as can be seen from (3.9). 
Since aircraft motion is modeled ina Cartesian reference 
frame and measurements are generated ina polar reference 
frame, +he resulting relationships among the states and 
measured values are nonlinear, as can be seen from the 


transformation equations shown below. 


X = R cCoS(E) sin (A) (31445) 

Ye = PteGOS (5h) scosd A) (3 .46) 

Z = 9R sin(s) {3 .47) 

Using these polar/Cartesian transformations 26 
nonlinearly combine the polar cbservaticns, 


three-dimensional Cartesian measurements are generated frem 


fee) <O form (3.48) below. 
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Zz, (k) R cos(E) sin(A) vy. (x) 
Zy (k) | = JR cos(E) cos(A)} + vy (k) (3.48) 
Zz, (k) R sin(E) v, (xk) 


where the observation matrix for KALMN1 is 


0000 0 
H (k) = 0031000 (3 .49) 
0 0 1 
and for KALMN2 is 
100 0 00 0 
H(k) = 0003100000 (3.590) 
000 0 10 0 


In order to compute the measurement error variance 
it is necessary to first linearize the measurement error. 
Differentiating equation (3.48) with respect +o each of the 
measurement variables yields (3.51), where s and c represent 


sin and cosine respectively. 


Rene & ==SAS 5 
J(x) = CAcE -rsAcE -ECRSE (3551) 
py oe 


meme we fina that the linearized cCartesian errors can he 


expressed as 


x R 
Te || hc) TE (3.52) 
ve V5 
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Therefore assuming no cross correlation of polar 
errors, the linearized Cartesian measurement Siogong 


ccvariance matrix is 
T 
R Ck) = J (Xx) R, (x) J (xX) (3353) 


The diagonal terms of R (k) are 


Bt, We = co” (otsE- sa + o2ck* ca ) + o@cE* sa® (3.54) 
R(2;2) =x? {(atse* ca + oPce*sa) + a@ck*cx | (3.55). 
= Dagar cE? + o? sE“ . (356) 


R (3,3) | 


The off-diagonal elements‘are 


BQinay = cto sE sk + (02 - roog ) cE sAcA (3.57) 
R(1,3) = (of - ra? ) sECESA (3 58) 
R(2,3) + (a2 - rof ) sEcECA (3.59) 


eaaeaue to the symmetry cf R (xk) 


R(2,1) = R(1,2) (3.60) 
heats, 1) = & (1,3) (3.61) 
Reto, 2) = R (2,3) (35562) 
It should be noted thar «he R(k) Mat=ix iS not constant 


since it depends on range, azinith, and elevation. 
2. Fil+er Initialization 
All three filters were initialized with reasonable 


tate values fcr position, velocity, and acceleration on the 


Meee rarst pass through the fiiter, since it is assumed that 
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the GDBS has maintained a good track for sometime prior to 
the final leg to the target. Consequently the covariance: of 
error for the initial state prediction vector is not set to 
an arbitrarily large number such as 70° , as is often done 
when there is little confidence in the initial state values. 
Instead 103 is used since it iS more consistent with the 
e@variance of error in good initial state values. This 
Simulated pass from some other tracking filter to the filter 
ef interest is r¢alistic and reduces the settling time. 
Program constants and constant array calculations 


for the Kalman H, ®, A, and Q matrices are set up on this 


th 


mest «teration. The process noise W is set at an 
arbitarily smali number to ensure that the gain matrix will 


not converge to zero and accentuate divergence problems. 
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BYE PRESENTATION OF RESULTS 


wm «60OmCOUU AL TITATIVE CBS ERV ATIONS 

Seven different filter configurations were ultimately 
implemented and evaluated with the GDBS simulation. These 
configurations are di scuss2d below and assigned 
alpha-numeric symbols for ease of reference. 

The sixth order alpha-beta filter, ALFBTA (AB) was 
implemented with the Simple parameter switching technique 
@eeraned an Chapter 3. However, the heading rate maneuver 
detection process proved to be too insensitive to slow 
Maneuvers and was therefore augmented with a «=rigqger that 
rese+ fiiter parameters when the heading error exceeded 3 
degrees. The results of this change proved to. 0 be 
worthwhile, as will be shown later. 

The next three filters are variations of the sixth order 
KALMN1 filter. UGG) = "Seca MNiiew.ehout edapeetion, (K11) is 
KALMN1 with the process noise adaptation scheme fer nodifing 
Q(k), and ({(K12) is KALMN1 adapted by resatting P(k), the 
errer covariance matrix, as discussed in Chapter 3. Filters 
(20) , (K21), and (K22) a@ue- Variations OF KALMN2Z which 


correspond =o the KALMN1 variants described above. 


u5 





Since the objective was to evaluate the accuracy and 
response of each filter in the final phase of bomb delivery, 
the simulation was initialized witn the aircraft withia 90 
seconds of the release point, at a speed of 480 knots, and 
on a heading within 10 degrees of the target bearing. das 
each run, after allowing 5 seconds for the rilter to settle, 
Tacan target bearing information was previded to the pilot 
@enctroiler. At 15 seconds elapsed time, filter adap*action 
was erabled and random maneuvers were begun at 20 seconds. 
Five separate runs were evaluated for each filter where the 
random maneuvers were ceased at 80, 60, 50, 4Q, and 30 
seconds prior te arrival at the release point. 

Tne following plotsewer2 generated for the case where 
Maneuvers were stopped with a ‘time-to-go of 50 seconds. 
peemres 4.1 threugh 4.21 show true and estinated(ccnnected 


73 


symbols) position, velocity, and acceleration «rajecto 


4 
(A 


iD 


Pemeeunet 2ons Of time for all filter configurations. Not 
oes ene target position is desiqnated by a circle on the 
MmerzOnmecel “rajectory plot. Also representative filter gain 
Sencaules are included»to show the effects of the particular 


adaptation process béing utilized. 
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Figures 41 and 4.2 indicate the Magnitude of the 


Maneuver encountered and the good state estimation qualities 
of this simple sixth order alpha~-beta filter. Notice there 
is no significant divergence of the estimated trajectcry 
from the true trajectcry throughout the fun. Figure 4.3 
shows the step gain adaptation at the beginning of the run 
in response +o the controlled turn to the target heading. 
This gain is then reduced after the turn is completed and 
before the first random maneuver begins, when the gain is 
again increased. 

The trajectory shown in Figure 4.4 contasts sharply with 
Brae Shown in 4.1, shoWing significant filter divergence for 
the nonadaptive sixth crder Kalman filter. The significant 
lag in velocity state estimation shown in Figure 4.5 results 
from the convergent gain proverties Gaerheeeerized in 
mower 2 tb. 6. 


The performance of K10 changes dramatically when it is 


rij 


Made adaptive as shown in Figures 4.7, 4.8, and 4.9 for KT11 
mmemeredices 4.30, 4.31, and 4.12 for K12. Figure 4.9 shows 


continuous gain adjustment in response to perceived changes 


ons ODS 


iD 


in the process noise. Figure 4.12 shows the eff 


resetting the covariance of error in response =c a maneuver. 
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Figures 4.13,and 4.14 show the improvement in state 
estimation of the K20 nonadaptive Kalman filter when the 
crder is increased over that of K10. it 2s mee esteng =o 
note that we see significant overshoot in the velocity 
estimate for the first time. Unlike the filters discussed 
thus far, K20 provides an acceleration estimate which can be 
seen in Figure 4.15 and accounts for the sensitivity of the 
velocity estimate. 

Adapting K20 through the noise process technique results 
a x 2 1 which produces the poesition, VELOC Y » and 
acceleration estimates shown in Figures 4.16, 4.17 and 4.18 
Pespectzvely. FYqures 4.19, 4.20, and 4.21 previde the same 
Maec=Meation for K22, which represents the covariance of 
error adaptation variant of K20. These last <*+wo adaptive 
filters show little, if any, apparent improvement over the 
nonadaptive version. Pils ObsemveetOn iS Suppertedyin the 


following section. 


meee OUANTITATIVE RESULTS 

meee mae sen, COL seach filter configuration evaluated 
for each maneuver termination time, Pome. © SUsri1Ccionmc =o 
properly determine filter performance over th2 range of 


possible Maneuver trajectories and measurement noise 
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sequences. Therefore, 30 simulation “*rajectories per 
filter, per maneuver period, were conducted with different 
random maneuver and measurement noises sequences generated 
fee each run. The bomb release signal <0 the pilot was 


assumed to occur at the closest point of approach(CPA) to 


th 


the target release point. The average of th2 resulting 
CPA's for each 30 test runs are shown in Table Tf. CPA'S 
Mecedee= than 250 feet are classifié€d unsatisfactory and 
labled 'U* appropriately. 

At a glance it is apparent that the adaptive sixth order 


alpha-beta filter performs very well in such a dynanic 


environment, except when maneuvers are continued very close 


to the target. The nonadaptive sixth order Kalman filter is 
Obviously unsuited oy itself, but when mad2 adaptive, 
preforms very well, pazticulanrly for the vorocess Rmoise 


adaptation *echnique when maneuvers are terminated late in 


as 


ehe target run. The ninth order Kaiman filter performance, 
both adaptive and nonadaptive, 2S comparable tc the 
eipha-beta and adaptive sixth order Kalman filters, but has 
problems in close due +o its longer settling <cinme. Nossace 
that the adaptive variants of the ninth order Kalman have 
little effect on that filter's performance, as we surmised 


moecne last section. 
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TABLE I 


Release Point Errer Table 


Alpha- 
Beta Kalman (sixth order) Kalman (ninth order) 
Ean 


AB K10 K11 pale? K20 K21 K22 
20! 46! 38° 39! 30! 30! BOK 
43° U 42' Seas 43! 39° 35° 

50 al! U 75! 53° 





Sa U Sau S) le 
Gable I~ shows the relative cost, in computation «ine 


and memory, to implement KALYN1 and KALMN2 in relation to 


ALFBTA. 
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Peace Coe 


Relative Computation and Memory Costs 


Alpha-Beta (sixth ord 


Raiman (sixth ord) 


Kalman (ninth ord) 





ct 


The only advantage to implementing he mest responsive 
Variant of KALMN1 would be to reduce the probability ofa 
GDBS generated abort, due to large predicted bomb inpact 
errors, when maneuvers are carried very close to the release 
EBeint . Lastly, if the adaptive Kalman identifier proved to 
be us¢ful in providing deterministi forcing for the Kalman 


fiicer model and resulted in improved accuracy and response 


over the alternatives presented, the cost in ccemputation and 


Gr 


Ger tnan we hav 


iD 
() 


]e=n) 


memcry resources wouid be even grea 


nere. 
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